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1. INTRODUCTION 


This paper presents a new recursive Newton-Euler procedure for the formulation and solution of 
manipulator dynamical equations. The procedure includes rotational and translational J oin ^s ana a 
topological tree. This model was verified analytically using a planar two-link manipulator Also, the 
model was tested numerically against the Walker-Orin (ref. 1) model using the Shuttle Remote 
Manipulator System data. The hinge accelerations obtained from both models were identical lhe 
computational requirements of the model vary linearly with the number of joints. The computationa 
efficiency of this method exceeds that of Walker-Orin methods. 


This procedure may be viewed as a considerable generalization of Armstrong’s method (ref. 2). A 
six-by-six formulation is adopted which enhances both the computational efficiency and simplicity ot 
the model. 


In section 2.1, we begin with assuming an open chain, rotational joints, and prescribed base 
motion. In section 2.2, the procedure is extended to translational joints. Section 2.3 extends the 
formulation to a topological tree. Section 3 includes the algorithm summary and computational 
efficiency. The appendix contains descriptions of coordinate frames and notations and a summary ot the 
standard kinematic relations used in the algorithm. 


2. DYNAMICS FORMULATION 

Let's begin with a quick look at the procedure. The first step is to set up the equations of motion 
for a generic link i (rotational) in the i - 1 frame in a 6 X 6 form; namely, SU i = F*. U { is a 6 X 1 
vector consisting of the reaction loads from link i - 1 on link i and 0 ( , the hinge acceleration of link i. S t 
is a coefficient matrix, and F * consists of the mass and inertia of link i (inertial parameters) acting on 
the inertial motion of the i - 1 frame, nonlinear terms, body forces and torques, control torques, and 
reaction loads between link i and link i + 1. 

The procedure consists essentially of two phases, the inbound and the outbound. In the inbound 
phase, one begins at the free end, i = N. Since there is no outbound link, the reaction loads from link N 
on link N + 1 are zero. Therefore, F* N is given by F* N = q N _ t N -i + ® n,N-1 w ^ ere (,N-1 

involves only link N inertial parameters. 

Now U R N _ t N [equation (2.1. 7.1)] may be solved for in terms of S s ~ 1 f A N N V q N _ J N _ lf 
and B n n _ 1 but not 6^. Now we are ready to proceed to link N — 1 and substitute U 
However, i ^ must be transformed to the N — 2 frame first. This transformation results in 

decomposing (U R N _ j into three terms: the first involving the second, q^_2,N -2 r an< ^ 

third, a collection of nonlinear and forcing terms. This decomposition enables one to group these terms 
with their counterparts from link N - 1. The resulting equation of motion is 

L N-1 U N-l =F N-1 


- ~r i riLtftD 
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Note that in this equation of motion for link N - l,d N does not appear, only & N _ r d N _ 2 , etc. 

Repeating the procedure by solving for U R i _ l - for i = N - 2, N - 3, .... we finally obtain the 
equation containing the hinge acceleration of the base link only. 

For the outbound pass, beginning at the base link, link 2, we compute 0 2 '^2^2’ anc * ^2^’ 
proceed to link 3 to compute 0 3 , and ((0 3 ) 3 , and so on to obtain all hinge accelerations. 

Now we proceed with a detailed description of the model. 

2.1 MANIPULATOR WITH ROTATIONAL JOINTS 

2.1.1 INBOUND PASS 


The translational equation of motion for the center of mass of link i in the i - 1 frame is (see 
figure 2-1 and the appendix) 

y’F , . = (— -0 — m ( v ,+(o x(co . X r*\ + (a). , + to ,Xz ,6 + z ,0 ) Xr') (2.1.1) 

‘ \ dt J,_i 1 V’ t ~ 1 V-« -»/ \-«-l -i-l -i -l t -i-i i/ -»/ 



OPEN KINEMATIC CHAIN 


LINK i FREE BODY DIAGRAM 


Definitions: 


W,_, 

'H + l.t’i-l 
'(i-l.i’.-l 


J 


the inertia forces developed in link i in the t - I frame 

the inertia torques developed in link i in the i - 1 frame 

the control forces applied at the proximal joint of link i in the i * 1 frame 

the control forces applied at the distal joint of link i in the i - 1 frame 

the reaction force exerted on link i by link i + 1 expressed in the i — 1 frame 

the reaction moment exerted on link i by link i + 1 expressed in the i - l frame 

the reaction force exerted on link r by link i - 1 expressed m the t - 1 frame 

the reaction moment exerted on link i by link i - 1 expressed in the i - 1 frame 

the position vector of the i frame relative to the i - 1 frame and expressed m the i - / frame 

the control torques applied at the distal joint of link i in the i - / frame 

the control torques applied at the proximal joint of link i in the t - 1 frame 

the external forces applied at the center of mass of link i in the i - 1 frame 

the external torques applied at the center of mass of link j in the i - 1 frame 

Figure 2-1. 
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E F is the total force exerted on the center of mass of link i in the i — 1 frame, p- is the linear 
momentum of the center of mass of link i in the i - 1 frame. * 


y F.=f ... +f , +f e ~f 


c f c 

1 + 1 4 1 


( 2 . 1 . 2 ) 


Substituting equation (2.1.2) into equation (2.1.1) yields the following translational equation of 
motion for any link i in the i — 1 frame: 


f + m ( r . X 2 . b\ =a. + $. + f. - f° - f C . j + F £ 
4 i-l,i : \-i -i-l i) -i 4 1 it, i + l it ii+l — i 

a = m .(u f + a) t X r ) 

—i i \-i - 1 -*i-l -i / 


(2.1.3) 
(2. 1.3.1) 


£ = m , ("i x x li ) + (?i-i x 4-i 

The rotational equations of motion for link i in the i 
proximal joint of link i) are 


fljxr) (2.1. 3. 2) 

— 1 frame (torque balance about the 


or 



(2.1.4) 


(2.1.5) 



= R 


i-i 


I R , 

i i i,t—i 




*i + l,i 


+ n , ,+N* + P*Xf... . 

--1-2,1 -»« -.i h+l,i 


(2. 1.5.1) 

(2.1. 5.2) 


N‘ = N E + r". X F E - P* X f c -n c + n c 

— l 1 { l l -l i l+l -*l+l l 

The rotational equation of motion for arbitrary link i is: 
n . + m r X (r X z — J \z. d)=a+fl.+rX(}—N t +rXa 

- i-l,t i -t \-i — i — l i/ i\^i-l ( y -i 


(2. 1.5.3) 


( 2 . 1 . 6 ) 


f- n . , -P X/*. f 

-i,i+l ■— t -4i + l,t 


a = J6) f 

i— i— i 


(2. 1.6.1) 

, Xz ,0 1 fa.Xj.fi). (2.1. 6.2) 

— »-l - 1 tj -»i i-*i 

Equations (2.1.3) and (2.1.6) may be combined and written in the following matrix form: 


P =J 

i 


S U =F 

i i i 


$] = [W> 

There is no reaction torque in the drive direction. 


T T a 


S. = I - Z.Z -A ,Z.Z - Z Z J 


(2.1.7) 
T (2. 1.7.1) 

(2. 1.7.2) 


where I is & 6 X 6 identity matrix, Z. is its last column, and J ^ is the actuator inertia associated with 
hinge i. 


F = A q .. + B. . . -h 

i i,i —l^i — l,i— i i ,i—l 


U R 


0 

i,i+l 


0 

0 


P X ... 

-r| -1,1 + 1 


(2. 1.7.3) 
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r f <>5 1 

i I -m r 
! [ J l [-1 J 


J — m T 

i i 




M 


„ A £i-£ + &,-?? 

n , * „ | (2.1. 7.6) 

P +r X 0 -N 

[I] is a 3 X 3 identity matrix, and /F*/ is a skew symmetric matrix associated with r*. 

Since the formal structure of equation (2.1.7) has been defined, consider link N (the link at the 
free end) and make use of the following boundary conditions: 


IN.N + J 


N,N + 1 


= <p =0 


L — S 

L N~ b N 


Therefore, equation (2.1.7) applied to link N is 

F N ~ A N,N-i q N-l + B N,N-1 (2.1.10) 

G =L~ l , \/i = l,2,...,N ( 2 . 111 ) 

^n =( ^n F n ( 2 . 1 . 12 ) 

Although the expression for was obtained in equation (2.1.12), & N cannot be computed until 
N _j and (^v_/ are. Therefore, proceed to linkAf - l and set up equation (2. 1.7) for i = N - 1. 

When transforming (U^ t ) into the i — 2 frame, the following recursive relation is used: 

*•(.<-. *<<-,) ■ Wi = /.2. ...AT (2.1.13) 

= 6 i Z i (2.1.13.1) 


X XP'J 


i - i ~ l -w . X 2. ,0 

— t-1 -J-/ l 


P T = 

l 


-[?: 


<p i 


I is a 3 X 3 identity matrix, and [P*J is a skew symmetric matrix associated with P*. 


N—l.N 


( A N,N-l) S 2 P N-l (Qn- 2 + °N-l,N-2 + °N-l,N-2 ) 
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P N -1 “ A N-l,N-2 q N-2,N-2 + B N-l,N-2 + 


U l 


R 

N-1,N 

0 


U R 


4> 

N-l.N 



0 

+ 

P n — i x I n -i,n 


N-2 



* 

I 

i 

I \-2 + Rn ~ 2 ’ N - 


N-2 


N-2 


A N,N -2 B N -2,N -1 ^^N A N,N-1 B N -2,N -1 

A N,N-2 = P N-1 A N,N-2 P N-1 

B N ,N-2 = R N-2,N-1 YG N B N,N-1 
* * * 

B N,N-2 = P N-J B N,N-2 + A N,N-2°N-l,N-2 


The superscript T denotes the transpose operator 

R 

. I 

R 


i i 


<P 


( 2 . 1 . 14 ) 

( 2 . 1 . 15 ) 

( 2 . 1 . 16 ) 

( 2 . 1 . 17 ) 

( 2 . 1 . 18 ) 


i-l,i 

<p R . . . 

Obviously, upon substituting for U R N I N into equation (2.1.18) for i = N — 1, we get 

F N-1 = ( A N-l,N-2 + A N,N-2) q N-2,N-2 + B N-l,S-2 + B N,N-2 + A N , N -2° N - 1, N -2 

Since A* N N _ 2 o N I N _ 2 is a function of 0 N _, only, it can be moved to the left-hand side to 
combine with its counterpart from link N — 1 . 

Thus, in general, the equation of motion for any link i takes the following form: 


L U =F 

l l l 

( 2 . 1 . 19 ) 

L. = S. -A*. ,Z Z T 

l l l+l,l-l l l 

( 2 . 1 . 19 . 1 ) 


( 2 . 1 . 19 . 2 ) 

A i ,i-l = A i,i-1 + A i + 1 ,i-l 

( 2 . 1 . 19 . 3 ) 


( 2 . 1 . 19 . 4 ) 

B i,i-1 ~ B i,i-1 + B i + l,i-l 

( 2 . 1 . 19 . 5 ) 

B i + l,i-l =P i B i+l,t-l + A i+l,i-l° i,i-l 

( 2 . 1 . 19 . 6 ) 

B i+l,i-l = R i-l,i V i + l^i+l B i + l,i 

( 2 . 1 . 19 . 7 ) 


2.1.2 OUTBOUND PASS 

Assume a prescribed base motion. In this case, Vj, cJj, and are given. First compute F 2 

and then solve for d 2 from the following equation. 
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( 2 . 1 . 20 ) 


•• m 

9 2 = Z 2 G 2 F 2 

Once 6 2 is obtained, (v 2 ) ? and (a > 2 ) 2 can be computed. This completes the outbound 
computational cycle for the base link. Next we can move on to link 3 and repeat the same sequence - 
namely, compute Fj, 83 , (Oj)^ <£3^, O 4 , etc., until all hinge accelerations are determined. Then we 
proceed to the integration phase. 


2.2 MANIPULATOR WITH TRANSLATIONAL JOINTS 

Some manipulators contain a mixture of translational and rotational joints. The procedure 
developed in the previous section for rotational joints is still applicable with slight modifications of the 
expressions involved (using the kinematics for translational link). These expressions include U , Z , 

a i.i-l> °i, i-i*> Pi’ an< * P* we denote these variables by a prime to distinguish them from their 
rotational counterparts, we get 


P =m[G) ,x[(o .Xi r)+2<a. ,Xz t 8 J 

i! l\-M -1 \"»i -1 -»t J -M-i -rl-l | J 

P = CD X J (O , 

Z 1 -1 -l 1 -1 -/ 


U = 

l 


B 


i,i-l 




, ( 1 ) 

n , 

I-l, l 

i-l, 1 

■c _ f c 

+ f e ~ 

i ii + 1 

— { 

r* X B 

-N‘ 

1 aTi 

— I 

i N 

l 

~ 1 



4> 


°i, i -l 


0 ) X (co X P*\ + 2 a) ,Xz ,8 

- 1-1 \- i-l -»i/ ->[ -i —i-i 1 

4> 

Z.=[0 0 1 0 0 of 

The remaining variables are defined as in the rotational joints case. 


( 2 . 2 . 1 ) 

( 2 . 2 . 2 ) 

(2.2.3) 

(2.2.4) 

(2.2.5) 

( 2 . 2 . 6 ) 
(2.2.7) 


Therefore, the equations of motion for any link i may be written in the following form: 

LU - F . 

1 t l 

where the formulas obtained in the rotational link case still hold. Note that the only distinction 
between rotational and translational joints is through the use of either/^, Pf, £T, cr and Z 

for rotational links or P{,P*' , U‘,o' , \ and Z f ' for translational links. 

2.3 TOPOLOGICAL TREE 


The case of a manipulator with tree topology does not alter the formulation in a fundamental 
manner. In fact, only the root links must be treated differently. 

Consider the system shown in figure 2-2. For any branch b , we can proceed as in the open chain 
case until the root link is reached. Denote the root link by K, hence 1 , 
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■RANCH ( 7 ) 



( 


u 


R 

K.K+l 



U 


K,K + l 


( 2 . 3 . 1 ) 


Recall that in the open chain case (U R ). was transformed to the i - 1 frame and expanded in terms 
of A* f q , and B* l, !+ 1 


Therefore, we get 


or 




U 


R 

K,K + 1 



+ . . . + 



( 2 . 3 . 2 ) 


m 


A k,k-i ~ a k,k-i + 2 - A K+1,K-1 
j=l 

m : 

K.K-l = B K,K-1 + 2 . B K + l,K-l 


B 


J = 1 


( 2 . 3 . 3 ) 

( 2 . 3 . 4 ) 


For any./, the definition of A* J K+1 K _ t andfl *-^ +l K1 is the same as that of the open chain. 

3. ALGORITHM SUMMARY AND COMPUTATIONAL EFFICIENCY 
3.1 OPEN KINEMATIC CHAIN 


Start at the free end, i = N. 


3.1.1 INBOUND PASS 


Repeat the following sequence for i = N, N — 

1. Compute .^and B* l+1 t _j (may be skipped for link N). 

2. Compute A*. . _ t and B* t i r 
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3. Compute L i and G ( . 

4. i = i - l and repeat until i = 2. 

3.1.2 OUTBOUND PASS 

Prescribed base motion: u , , o> ; , a> ; , and are given. Repeat the following steps for i = 2, 3, . . . N. 

1. Compute either orF '(i = /). 

2. Compute 6L 

3. Compute (a?- ) and (v;) . 

-F i t 

4. i = i + 1 and repeat steps 1 through 3. 

3.2 TOPOLOGICAL TREE 

3.2.1 INBOUND PASS 

Apply the open kinematic chain procedure to all branches until the base node is reached in this 

case. 

1. Compute >JC _ ; andfl% + | ,k-i otA * j K+l andB*'^ ^ for all 

j — 1,2 m where m is the number of branches at the base node. 

2. Compute A* K K _j and B* K K _ r 

3. Repeat steps 2, 3, and 4 as in the open chain unless another is reached; in such case, repeat 
steps 1 and 2. 

3.2.2 OUTBOUND PASS 
No change. 

3.3 COMPUTATIONAL EFFICIENCY 

The number of multiplies is equal to 258N - 119, and the number of adds is equal to 191N - 83, 
where N is the number of links. 

4. CONCLUSIONS 

A general procedure for the formulation and solution of the equations of motion for a rigid 
manipulator has Deen presented. This procedure includes a solution for the tree topology. The 
extension to a closed kinematic chain follows naturally. However, the presentation of this extension is 
pending formal implementation and verification. 
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APPENDIX 

LINK COORDINATE FRAME AND NOTATION 

We adopt a dynamic reference frame. This frame is used here with the Denavit and Hartenberg 
convention (ref. 3). The joints are points of articulation between links and are numbered such that 
joint i connects link i — 1 and link i. Consequently, joints i and i + 1 are the proximal and distal joints, 
respectively, of link i. Each link i is assigned a Cartesian coordinate frame, (x,y, z ), which is fixed on 
the link and therefore moves with it. (See figure A- 1.) * 1 1 
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Figure A-l 


The z axis is the axis of the rotation/translation of the distal joint of link i. The x ■ axis is directed along 
the common normal from z- _ j to z-. The y- axis equals z ■ X to complete the right-handed system. 


In order to associate a particular vector with the coordinate frame, an indexed parenthesis notation is 
introduced as follows. 

(0. ) = the link i relative displacement with respect to and expressed in the i - 1 frame 

J i — i 

(P* . ) = the position vector of the i frame relative to and expressed in the i - 1 frame 

To relate two neighboring coordinate frames, a transformation from the i - 1 frame to the i frame is 
defined as successive rotations of 8 ^ about the z- axis followed by <p- about the x ■ axis. (See figure A-2.) 
This is denoted as 


K u-. =*<*., W'K, 

sin 8 

i 

cosfp^ cos 6 . 
-sintp^cosd^ 


cos 8 

i 

-cos<b sin 6 

r i i 

sin 0^ 


0 

sin A 

T i 

COS^ t 


(A 1.1) 


R- 1 =R T =R 
1,1—7 i,i — 7 i — l,i 


(A. 1.2) 



a cos 6 

i i 


a sin 8 

i t 


s 

i 


(A. 1.3) 



Note: When the and z i axes are aligned, it implies that 8 t - 0. 

Figure A-2 
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The following is a set of standard kinematic relations (see figure A-3) for the motion of a rigid body 
relative to a moving reference frame. 
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l — 1 I 


and 




if link i is rotational 
0 if link i is translational 



Figure A-3 


(*‘L 'i 0 0 “■[, 

(«*).-, = (*•),., = [° 0 C, 


(A. 2.1) 


(A.2.2) 

(A.2.3) 

(A.2.4) 

(A.2.5) 
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